#!/usr/bin/python
# -*- coding: UTF-8 -*-

from MiniBotControlLib import MiniBotControlLib


# ------------------------------
# 	1、连接设备 Connect
#   2.25、设置外部设备参数 SetSensorData
#   2.26、从数据缓冲读取设备数据 ReadSensorData
# 	6、断开设备 Disconnect
# ------------------------------

# 声明控制库对象
mlib = MiniBotControlLib("udp")


# *************************
#   1、连接设备
#*************************#
ip = "192.168.1.193"  # "10.10.200.254"
r = mlib.Connect(ip, 8899)
# 带超时的连接方式
#r = mlib.Connect(ip,8899,2000)
if(r > 0):
    print("连接成功")
else:
    print("连接失败")


# *************************
#   2.25、设置外部设备参数
#*************************#
# 开启遥控传感器
r = mlib.SetSensorData(0x06, 1, [])
if(r > 0):
    print("设置成功")
else:
    print("设置失败")


# *************************
#   2.26、从数据缓冲读取设备数据
#*************************#
# 读取遥控传感器的检测指令
r = mlib.ReadSensorData(17, 0x03)
print("rs="+str(r))


# *************************
# 	3、断开设备
# *************************
input("输入任意字符回车，断开连接")
r = mlib.Disconnect()
if(r > 0):
    print("断开成功")
else:
    print("断开失败")
